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FOREWORD 



This report preseats the results of a slz~month study by Martin Mari- 
etta for the National Aeronautics and Space Administration's George C. 
Marshall Space flight Center. The study was the third phase of Con- 
tract NAS8-34679, Development of an Autonomous Video Rendezvous and 
Docking System. It resulted In Improvements to the spacecraft video 
guidance system developed under previous phases of the contract. 
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SUMMARY 


ImproveDents have been made to the video rendezvous and docking system 
developed under this contract. The changes allow the system to dock 
with targets tumbling twice as fast as the old system could accommo- 
date. They also improve reliability at lower tumble rates. The Im- 
proved performance results from: 

1) Adding a second Kalman filter to Improve estimates of target ittl- 
tude and allow anticipation of target attitude changes; 

2) Changing the guidance strategy to make use of the data from the 
Kalman filter. 

Other minor changes were made to Improve performance. Larger thrusters 
were used on the sides of the chase spacecraft, and a higher-resolution 
(broadcast quality) television camera replaced the original 128-llne 
camera. 

Improving performance further will probably require multiple docking 
aids or an auxiliary radio frequency (RF) system, because the system Is 
now limited primarily by the docking aid rolling out of sight behind 
the target. Although the Kalman filter allows dead reckoning, the ac- 
curacy of Its position estimates deteriorates with time, especially 
when the chase spacecraft attempts to maneuver around the target. 

Application of artificial Intelligence In the guidance system might 
minimize this problem, and precision accelerometers could slow the 
growth of estimation error. However, the problem will still be diffi- 
cult to solve without some form of additional sensor data from the back 
side of the target spacecraft. 
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INTRODUCTION 


The study reported here was the third phase of a contract to Investi- 
gate techniques that could be used In an autonomous video rendezvous 
and docking system for spacecraft. 

Under the first phase of the contract, we Identified several techniques 
that appeared suitable for such a system, defined the equations and 
algorithms these techniques would use, and evaluated video guidance 
control systems based on these techniques through computer simulation. 

To ensure that practical problems were considered, the simulation mod- 
eled not only the sensor, but also methods for dealing with a number of 
practical problems, e.g., maintaining control when the target space- 
craft leaves the field of view of the guidance sensor. The simulation 
also modeled the characteristics and limitations of practical space- 
craft to reveal subtle Incompatibilities that might otherwise go unno- 
ticed. A mission model was defined to serve as a basis for the 
simulation. 

In this model, the chase vehicle (Fig. II-l) Is a general-purpose 
spacecraft for repair, refurbishment, and retrieval of other space- 
craft. After It Is deployed from the Space Shuttle, It must rendezvous 
and dock with the long-duration exposure facility (LDEF), which. It Is 
assumed, has been modified for this operation and Is In a circular or- 
bit at an altitude of 300 km> We will refer to LDEF as the target 
spacecraft, because, although a specific mission model was used for the 
simulations, the Intent was that the guidance method be usable on a 
variety of spacecraft. 

In the second phase of the contract, we conducted a physical simulation 
of the best technique evaluated under the first phase. This technique 
used a docking aid comprising three flashing lights mounted on the tar- 
get spacecraft (Fig. 11-2). The appearance of this pattern of lights 
uniquely defines both the relative positions and the relative attitudes 
of the two spacecraft. 
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Figure II-l Chase Vehicle Modeled in Simulation 
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Figure II-2 Three Light Docking Aid 
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To simulate the entire operation from a range of 300 m to contact, 
three target- spacecraft models were required (Pig. 11-3). Each model 
was built to e different scale and was used In a different part of the 
simulation. The smallest model was 1/100 scale and was used for ranges 
greater than approximately 30 m. A 1/10 scale model was used to simu- 
late ranges between 3 and 30 m. For the final seconds of the docking 
operation, a full-scale model of a portion of one side of LDEF was used. 



Figure TI~3 Scale Models and Simulator Used for Physical Simulation 

To simulate the servicer spacecraft (chase vehicle), we mounted a tele- 
vision camera on a slz-degree-of-freedom simulator. The simulation 
computer sent servo commands to position the camera so that the televi- 
sion Image would correspond to what a flight camera on a real chase 
vehicle would see. Video processing electronics (Fig. II-4) converted 
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the Imagery to a set of statistics that a computer can quickly analyze 
CO determine the relative positions and attitudes of the two space- 
craft. These statistics were transmitted to the simulation computer, 
which modeled the activity of the simulated flight computer and the 
dynamics of the two spacecraft. 



Figure II-4 Video Prooeasing Eleotronic'S Ueed in Phyaioal Simulation 

Although the work under these two phases demonstrated the apparent 
practicality of a video guidance system. Improvements were required for 
docking with tumbling spacecraft. The original system was unable to 
cope with target attitude rates caterlally over 1000 deg/h, and was 
unreliable at this rate. 



Part of the problem was that the Kalman filter, iriilch che guidance sys- 
tem used for dead reckoning, did not keep track of target attitude. 


This made It nearly impossible for the chase vehicle to recover grace- 
fully when the docking aid on the target rotated out of view behind the 
target (Pig. II-5). 
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CharacteH^Ho, of old Sy,u„ WHen Docking Aid Could ,ot 

toother probita mi itretesy lojlc that dw not pUo eheed for a rotit- 
to« tirsot: the cheee mhlcie built up too euch epeed la epproechla, 

the tertet, uela, pomrlul thru. ten et the rear of the epeeecreft. 

Wheo It errlwd la the vlclalt, of the terjet. the ter,et bed routed, 
ead the eheie mhlele had to fl, .idem,, for th. U.t fe. ...... It 

m. thea uothle to .top cjulckl, eaou|h ulth the maker .Ida thrueter. 
tnd overshot the target (Plge II-6). 

The activity under Phase 3 addressed these shortcoaCrga by .aklQc 1«- 
proveaents In the strategy logic and augaentlng the Xalaan filter to 
target attitude and tuable rate. 
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This report concentrates on the third phase of the contract and does 
not repeat very auch of the inforaation that was published in the final 
reports for Phases 1 and 2. The reader who has not read those reports 
will find it advantageous to read thea before reading the aore techni- 
cal sections of this voluae. 
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CONCLUSIONS AND RECOMMENDATIONS 


A. NEW SYSTEM WORKS WITH HIGHER TARGET ATTITUDE RATES 

The changes made under this contract phase have approximately doubled 
the tumble rates the chase vehicle can accommodate. This Improvement 
was achieved primarily by: 

1) Adding a second Kalman filter, which estimates target attitude and 
angular momentum; 

2) Changing the goal-selection and attitude error computations. 

The system now works reliably at rates up to 1000 deg/h and, depending 
on Initial conditions, can cope with rates up to 4000 deg/h. 

B. HIGHER RATES REQUIRE MORE LIGHTS OR AUXILIARY RF SYSTEM 

The main factor that now limits rates the system can accommodate Is the 
fact that the docking aid on the target rotates out of view before the 
chase vehicle can get close to the target. The result Is that the 
chase vehicle must fly a significant distance on dead reckoning. It 
can do this for a short time, but maneuvering to the far side of the 
target requires considerable use of Its thrusters. 

Unfortunately, each time the thrusters are used, the system loses con- 
fidence In Its position and velocity estimates. This Is because the 
velocity change that results from thruster operation cannot be pre- 
dicted or measured exactly. The thruster may produce slightly more or 
less thrust than was anticipated. To be safe, the guidance strategy 
must take this loss of confidence Into account and back away from the 
target . 
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If the system cannot get another measurement for an extended period. It 
must retreat a considerable distance from the target. It Is then In a 
poor position for a second approach when the docking aid Is again 
visible. 

If multiple docking aids were provided, the system could always get a 
position update and would not have to back away from the target. The 
result would be: 

1) A significant savings In fuel consumption; 

2) Shorter time of flight; 

3) Greatly increased reliability; 

4) Ability to accommodate significantly higher tumble rates. 

An alternative method of avoiding the problem is an auxiliary RF guid- 
ance system that could provide at least range and direction to the tar- 
get when the docking aid Is out of view. Precision accelerometers In 
the existing system would also help by slowing the growth of estimation 
error. 

C. FIELD-OF-VIEW LIMITATIONS PROVED TROUBLESOME 

During the physical simulations under the second contract phase, we 
found that two different camera lens focal lengths were required. This 
requirement was confirmed under the current study. At great distances 
from the target, the system needs a lens with a long focal length to 
resolve details on the docking aid. At close range, however, such a 
lens becomes a problem; because of transient attitude excursions, por- 
tions of the docking aid frequently leave the camera’s field of view. 
The system then cannot take new measurements and must back away from 
the target as its position estimation accuracy deteriorates. 
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We solved this problem by switching focal lengths at a range of 15 m. 
Alternately, the problem might be solved by using a second, smaller, 
docking aid, which would be activated after the chase vehicle ap- 
proached within approximately 15 m. However, even a very small docking 
aid could leave the field of view of a long lens. Switching lenses 
appears to be the more practical solution. 

HIGHER RESOLUTION WAS REQUIRED 

We found It necessary to increase the camera resolution to approximate- 
ly that of commercial broadcast cameras to cope with high tumble 
rates. The reason was that at rates over approximately 2000 deg/h, the 
docking aid often rotates out of sight behind the target before the 
chase vehicle gets close enough to get precision measurements with a 
lower resolution camera. If It Is to go on dead reckoning for a signi- 
ficant distance, starting with a good Initial state estimate Is vital. 
The 128-llne camera modeled In previous simulations did not provide a 
good enough estimate. 

SIDE THRUSTERS WERE TOO WEAK 

We found It necessary to Increase the thrust authority of the thrusters 
on the tor , bottom, and sides of the chase vehicle. There was a great 
difference In authority between these thrusters and those mounted on 
the front and back of the vehicle (an 8 to 1 ratio). The result was 
that the chase vehicle tended to greatly overshoot the target when It 
had to brake with the side-mounted thrusters. Part of this problem 
could be solved by changes to the control law, but these changes were 
not particularly effective. 

At the same time, we Increased the torque authority to cure problems 
with the docking aid leaving the field of view for extended periods 
during maneuvers. 



F. POUNCE STRATEGY WOULD REQUIRE MULTIPLE DOCKING AIDS 

During this study, astronauts were practicing with the Manned Maneuver- 
ing Unit simulator at Martin Marietta Denver Aerospace. They were 
training for a mission In which they are to dock with the Solar Maximum 
Spacecraft, which Is, at the time of this writing, tumbling In orbit 
due to a malfunction. The similarity between their mission and the 
mission model for the video rendezvous system suggested that we should 
try to adopt techniques they found effective. 

One of the things they learned was that It was most effective to stop 
at a convenient position close to the target spacecraft and wait for an 
opportune moment. They would then pounce on the target from close 
range, matching the tangential velocity component only during the last 
seconds of flight. 

We Incorporated this technique Into the simulation program and ran a 
number of simulations. The results were disappointing. 

The reason the technique failed became quite obvious: while the chase 

vehicle was waiting to pounce, the docking aid was on the opposite side 
of the target spacecraft. Because the system gets data only from ob- 
serving the docking aid. It had to operate on dead reckoning for two 
minutes or more. As Its confidence In Its position deterloratei , It 
backed away from the target to prevent collision. In doing so. It used 
Its thrusters, and the thrust uncertainty further reduced Its confi- 
dence In Its position estimate. As a result, It backed farther and 
farther from the target, so when the docking aid was again visible, the 
chase vehicle was as far from the target as when the simulation start- 
ed. It went through cycles of approaching and retreating until It ran 
out of fuel. 

The astronauts did not have this problem because they could obtain as 
much position data from the back side of the target as from the front. 
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If the chase vehicle could see several docking aids at various loca- 
tions on the target, it too might be able to make effective use of the 
strategy. However, with a single docking aid, the most effective ap- 
proach was to keep the docking aid in view as much as possible. 

G. ARTIFICIAL INTELLIGENCE COULD HELP 

One of the shortcomings of the guidance system is its inability to rea- 
son about the following: 

1) Long-range goals - The guidance system treats each decision inter- 
val of approximately 1.2 s as a separate problem. It does not plan 
an optimal trajectory and stick to it; it does not think about the 
long-range consequences of its decisions. As a result, it often 
wastes time and fuel in undoing its previous actions. 

2) Interaction of goals - The system knows that it must back away from 
the target for safety when it cannot see the docking aid. But in 
deciding to back away, it does not consider how much doing so will 
degrade its position estimates. By reasoning about this, it might 
decide to postpone the use of thrusters. 

3) Alternate strategies - Although the algorithm used in the system 
does consider a variety of factors (safety, control loop bandwidth 
requirements, anticipated target motion) it is still a single 
strategy. The system does not predict the results of alternative 
strategies and select one. A system that considered alternative 
plans might perform better. 

Although much of the reasoning process for an intelligent guidance sys- 
tem would require numerical computation, a large portion of the task 
involves symbol manipulation, tree-searching, backtracking and other 
operations that are difficult to perform in most computer languages. 

For example, a program to search a decision tree is easiest to write 
and understand If the computer language used allows recursive function 
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calls, flexible data structures, and automatic garbage collection. 
FORTRAN Is weak In all these operations, and although C and PL/I sup- 
port some of them, these languages do not offer the flexibility of LISP 
and Its derivatives In solving problems of this type. 

A reasonable next step In developing a better guidance system would be 
to analyze the knowledge-base requirements of such a system and develop 
knowledge-representation schemes for automated reasoning about the fac- 
tors discussed previously. 
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SIMULATION RESULTS AND DISCUSSION 


Although almost all the improvemeut In measurement accuracy in the new 
system (Table IV-l) can be attributed to the higher resolution televi- 
sion camera, the new system had much better control accuracy. The old 
system would often dock with more than 45-deg misalignment at target 
attitude rates as low as 500 deg/h, and at 1000 deg/h, It rarely docked 
with misalignment less than 15 deg. Furthermore, at rates of 1000 
deg/h and above. It frequently crashed Into the target or let the tar- 
get get out of Its field of view long enough that It was not able to 
recover. 


Table IV-1 Measurement Errors 


Range (m) 

Position Errors (m) 

Attitude Error (deg) 
Pitch, Yaw, or Roll (la) 

Along Chase Vehicle 
x-Axis (lo) 

Along Chase Vehicle 
y- and z-Axes (lo) 

10 

0.141 

0.100 

0.362 

25 

0.318 

0.0964 

0.628 

50 

1.76 

0.303 

0.941 

100 

9.80 

0.970 

1.85 

286 

117 

6.32 

9.33 


The new system's performance at these rates Is Illustrated In the tra- 
jectory plots In Figures IV-1 through IV-5. In each of the simulations 
Illustrated, the chase vehicle started from a randomly selected posi- 
tion approximately 300 m from the target. Because problems rarely de- 
veloped until the range was reduced to 30 or 40 m, the figures show 
only the last 60 m of the flight. The boxes shown In the figures rep- 
resent a 60-m cube. Its primary use was to enhance depth perception 
when stereo pairs of plots were viewed while we were running the 
experiments. 

The primary reason for docking failures at the higher rates was the 
docking aid's rolling out of sight before the chase vehicle could get 
close enough to prevent It. This fact Is Illustrated dramatically In 
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Figure IV-3: with a target tumble rate of 2000 deg/h, the lights often 

rotated out of sight while the chase vehicle was still some distance 
away. Because the tumble rate was low, the lights did not reappear for 
six minutes. By this time, the chase vehicle's state estimate had bad- 
ly deteriorated. Although the chase vehicle was often able to recover 
from this by going around the target (Pig. IV-6a) or waiting for the 
docking aid to reappear (Fig. IV-6b), It generally used an excessive 
amount of fuel (Table lV-2). The success rate at 2000 deg/h was actu- 
ally lower than at 3000 deg/h. 



Figure IV~1 Typical Trajectory with Target Roll about Docking Axie 
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Note : 

A rate *u00 degrees per hour was the most troubles , because the docking 
aid was oMt of sight for the longest time. In (a) t < h), the pitch axis was 

the tunbU px's; in (c)-(f), the yaw axis was the axis: Simulations (b) , 

(e), and t) were stopped when an arbitrary v ime v.rs reached. 



Figure IV-3 Ferfomanae with Pitch and You Rates of 2000 deg/h 
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Note: 

In (a) the chase vehicle fc>und a path 
it did not but waited for the docking 



Figure IV-6 Recovery from Docking Ai. 


around the target. More frequently 
aid to reappear (b). 



Rolling Out of Sight 


Table IV- 2 

Comparison of Fuel Use and Time of Flight for Old and New Systems 


Pitch or Yaw 
Rate (deg/h) 

Old System 

New System 

Median Time 
(s) 

Median Fuel 
Consumption (Kg) 

Median Time 
(s) 

Median Fuel 
Consumption (Kg) 

1000 

192 

28.4 

227 

53.9 

2000 

279 

54.7 

00* 

00* 

3000 

201 

27.2 

00* 

00* 

4000 

201 

31.2 

00* 

00* 


*Chase vehicle did not appear to have a chance of docking after 280 seconds of 
flight. Simulation terminated. 


We partially succeeded la overcoming this problem by using a goal-modi- 
flcatlon strategy. The guidance logic analyzed the shortest path from 
the current position to the docked position. If It found that the path 
would pass too close to the target, It attempted to select an alterna- 
tive near-term goal on the shortest circular path around the target at 
an acceptable radius. This approach was not as successful as we had 
hoped. It appears that In pursuing the new goal, It had to make large 
velocity adjustments, which resulted In Increased uncertainty In Its 
position knowledge. It then had to back away from the target for 
safety. 
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The largest coatributor to fuel savings In docking with slowly tumbling 
targets was the widened deadband allowed In the new control system. 

The Improvement was not large, but It was noticeable. 


Kalman Filter 
Improvements 
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KALMAN FILTER IMPROVEMENTS 


A. TWO SEPARATE FILTERS WERE USED 

The original simulation program used a Kalman filter that estimated 
only position and velocity. The guidance algorithm was based on an 
assumption that the attitude measurements were accurate enough without 
filtering. The disadvantages of this scheme became apparent when signi- 
ficant target attitude rates were simulated: because the chase vehicle 

could not anticipate the motion of tha docking fixture, it always head- 
ed toward the instantaneous docking-port position, not toward where the 
port would he at the time of arrival. When the attitude rate exceeded 
1000 to 2000 deg/h about either the pitch or yaw axis, the guidance al- 
gorithm was not able to cope. The chase vehicle either circled the 
target indefinitely or crashed into the target. Furthermore, the chase 
vehicle's attitude control algorithm used the video imagery for guid- 
ance, attempting to keep the light pattern in the middle of the field 
of view. This strategy caused problems when the target was tumbling, 
because centering the lights in the field of view did not guarantee 
that the docking fixtures would be aligned. 

The modified guidance system solves both of these problems, and the key 
to the solution was an expansion of the Kalman filter to Include atti- 
tude and attitude rate in addition to translational quantities. 

The first design decision was whether to add state elements to the ex- 
isting Kalman filter or to split the problem into two Independent sub- 
problems, chase vehicle position, and target attitude. We considered 
the Increase in burden on the flight computer, the likelihood of filter 
stability problems, the degree of coupling between position and atti- 
tude measurements, and the absence of coupling between position dynam- 
ics and attitude dynamics. 
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We concluded that If we could reduce the measurement coupling, two fil- 
ters would give essentially the same accuracy as a single larger fil- 
ter, but with less likelihood of Instability problems and with a signi- 
ficant reduction In the burden on the flight computer. 

Therefore, only slight modifications were made to the original position 
filter, and an Independent target-attitude filter was added. 

B. NEW FILTER ESTIMATES TARGET ATTITUDE AND ANGULAR MOMENTUM 

For state variables, the added filter uses a quaternion and an angular 
momentum vector. Attitude Is expressed with respect to the nonrotating 
primary reference frame used for chase vehicle guidance. The angular 
momentum vector Is also expressed In this frame. 

1. Selection of State Variables 


We selected the quaternion parameterization of attitude to minimize the 
computational burden. The other parameterlzatlons we considered were: 

1) A set of three angles, e.g., yaw, pitch, and roll; 

2) The Gibbs vector parameterization; 

3) A direction cosine matrix; 

4) Euler axis and angle; 

5) The first three elements of a quaternion. 

The three-angle parameterization was rejected because It requires com- 
plex formulas for use. For example, the simplest way to propagate the 
state estimate Is to convert to one of the other parameterlzatlons. 
Furthermore, the approach requires added logic to handle exceptions at 
singularities. 
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We rejected the Gibbs vector approach for the same reasons: the com- 

plexity of the formulas and the presence of a singularity that requires 
special handling. 

Direction cosine matrices have three disadvantages. First, they have 
nine elements to compute, six of which are redundant. Second, the 
propagation formula requires approximately 30X more arithmetic than the 
formula for quaternions. Third, they require much more arithmetic than 
quaternions do for Incorporating a new measurement. 

The remaining two options were rejected because the simplest way to use 
them Is by converting to quaternions for computations and then convert- 
ing back to the original form. For example, the first three (or any 
three) elements of a quaternion can be used to express attitude In the 
theoretical minimum number of elements as long as the sign of the 
fourth element Is known. This Is true because the sum of the squares 
of the elements always equals 1.0. Because multiplying all four ele- 
ments of a quaternion by -1.0 does not change the attitude expressed. 

It Is always possible to manipulate the quaternion so that the last 
element Is positive. When this is done, the last element Is completely 
redundant and can be dropped. However, there Is little to be gained by 
dropping an element and much to lose. The simplest way to use the 
three remaining elements Is to recreate the fourth element. Further- 
more, when this element Is small, roundoff errors will prevent accurate 
reconstruction. 

In summary, the quaternion representation appeared to be best for this 
application. Therefore, the first four state variables are the four 
elements of the quaternion that represents the target's attitude with 
respect to the primary reference frame. 

The next three elements were to be some measure of attitude rate, which 
can also be parameterized In different ways. We considered: 


1) The angular velocity vector In the current target reference frame; 



2) The angular velocity vector In the prloary frame; 

3) The angular momentum vector In the current target frame; 

4) The angular momentum vector lu the primary frame. 

He selected the angular momentum vector » expressed In the primary 
frame » because this vector does not change with time. This fact sim- 
plified state estimate propagation and anticipation of target attitude 
changes In the guidance strategy algorithm. In addition, this parame- 
terization made It easier to analyze the filter's accuracy, stability, 
and rate of convergence while we were running simulations. 

The remaining three elements of the state vector, then, are the z, y, 
and z components of the target's angular momentum vector, expressed In 
the primary reference frame. This makes a total of seven state varia- 
ble elements. In the simulation program, they are the seven elements 
of the array ESTA. 

2. State Estimate Propagation 

Between observations, the filter propagates the state estimate covari- 
ance by linearizing about the current estimate. To do this. It com- 
putes a matrix of partial derivatives, F: 
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where z and i are the state vector and its rate of change. F Is evalu- 
ated by assuming x equals the current state estimate. 



From F It .omputes a state transition matrix. Ignoring changes In F 
over the Integration step: 

[2] 4> = 1 + AtF + %(At)2 F~ 


where 


At, represented in the simulation program as STEP, Is the Integration 
step; 

4>, represented In the simulation program as PHI, Is the state transi- 
tion matrix. 


It can compute the state estimate at the end of the Integration step by 
second-order Runge-Kutta Integration: 



[4] 

[5] 


S-t " (a. + ki)/(|£ + ki |) 

r»2r\^)LAt 

k2 -a^®| J-- — 


, , 1 + + k2)/(li + hiki + k2> I) 

[ 6 ] 

L 


where 
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represented in the prograa as the first four eleaents of ESTA» is 
the quaternion portion of the state estiaate vector; 

represented in the prograa as the last three eleaents of ESTA» is 
the estiaated target angular aoaentua; 

represented in the prograa as ESTA, is the full state estiaate; 

1 , represented in the prograa as ININV, is the Inverse of the tar- 

get aoaent-of-lnertia tensor, idiich is assuaed known; 

Lt is, again, the integration tlae step; 

— 1* '^t* —2* prograa as Kl, QI, and K2, are 

quaternion-valued Interaedlate results; 

A^(^) is the direction cosine aatrlz corresponding to quaternion £ 

(for any £>; 

The syabol ® denotes quaternion aultipllcation. 

The estiaate *8 covariance is coaputed froa 

+ Q 

where 

?, represented in the prograa as PA, is the state estiaate *s covariance 
$ is the state transition matrix Equation [2] ; 

Q, represented in the prograa as Q, is an eaplrlcal, constant, positive 
diagonal aatriz that represents state noise, i.e., the uncertainty in- 
troduced by siaplifylng assuaptlons in the dynaalcs aodel, roundoff and 
other errors in nuaerlcal Integration, and unaodeled torques. 
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To compute F, the program first computes the Intermediate results 


[8] j = 


i 


where 

I represented in the program as ININV, Is the Inverse of the tar- 
get moment of Inertia tensor; 

\ (1) f represented In the program as AT, Is the direction cosine ma- 
trix that corresponds to the quaternion portion of the state estimate 
ESTA. 


The program then computes 


[9] 


110 ] 
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[ 12 ] 


[13] 

D4 


■-qa 

q** 

qr 

-q4 

-qa 

q2 

. 'll 

q2 

qa 


■ q4 

qa 

-q2" 

-qa 

q4 

qi 

.q2 

-qi 

q4. 
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[14] 

[15] 

[16] 


B - CI-^ 
w * JL 


0 

U)3 

-0)2 

Uj 

-u)3 

0 

“1 

0)2 

0)2 

-0)1 

0 

“a 

-Ul 

-0)2 

-U3 

0 


[17] - BD^L for i - 1, 2, 3, 4 



where 

u, represented In the prograr. as twice the variable HAV (to reduce coa- 
putatlon), is the estlaated angular velocity of the target; 

L, represented in the program as the last three elements of ESTA, is 
the angular momentum portion of the state estimate ESTA; 
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are elemeats of 
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Other quantities are intermediate results or are as in previous 
equations. 

The F matrix Is assembled from these Intermediate results: 


1181 

F - 

r ' ' 1 1 

IHlj “2 1 “3| "4© 

■Jl 

.0“ 

1 

1 

1 

i 

i 

1 

[ Hie 

fH 

0-1 , 1 Oo 1 * 0-1 1 1 0-5 1 

3x4 j 3x1 j 3x1 j 3x1 J 


where represents column 1 of the matrix J, and the other symbols 
are as previously defined. 

These calculations are done In subroutine PRPESA. 

3. Filter Update 

Each time the guidance system receives a new Image Interpretation, It 
updates the state estimate. The formulas used are baaed on the normal 
extended Kalman filter equations, except for one small change: normal- 

ly linearisation would be about the current estimated state. In this 
filter, however, a coordinate transformation is done first: the state 

estimate and covariance matrix are transformed into the (currently es- 
timated) target body coordinate system. This approach was adopted In 
an attempt to minimise the effects of nonllnearltles. After the state 
estimate and covariance matrix are updated, they are converted back to 
the primary coordinate system. 

The formulas used are best presented procedurally: 

First compute R, an empirical positive diagonal matrix that represents 
the measurement noise covariance. This calculation, done In subroutine 
ATMCOV, Is based on a formula derived from fitting a curve to experi- 
mental data: 
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I19J R ■ diag [v V V v/lOOJ 
where 

[20] V - 1.129 X 10-5 |R| + 0.0001 


Secood, compute 


[ 21 ] 

P* 


FT I T 

t"PhT I t"Pi2 

T T ^ 

L(T Pl2) I P22 
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quality 


where 


T, represented in the program as T, is a transformation matrix formed 
from the elements of the quaternion portion of the state estimate ESTA 


[ 22 ] 



-93 

92 

91 

93 

94 

-9l 

92 

-92 

9l 

94 

93 

-91 

-92 

-93 

94 


P*, represented In the program as PA, Is the transformed covariance 
mtarlx; 

are submatrlces of P, which Is partitioned between the fourth and 
fifth rows and betweeo the fourth and fifth columns. 

The program uses the array PA for both P and P* to save space, because 
P and P* are never needed simultaneously and because a portion of P 
does not change in the tranwformatlon to P*. 
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[ 23 ] 


Third, calculate the Kalman gain matrix K, represented in the program 


as K: 


K = P* G^(R + G P* G^) 
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In Implementing this equation In the program, It was not necessary to 
explicitly multiply by the sensitivity matrix G, because it has the 
value 


[ 24 ] 


G =» 


"1 0 0 0 0 0 0 ‘ 
0 1 0 0 0 0 0 
0 0 1 0 0 0 0 


and serves merely to select elements of P*. 

The state estimate and covariance are now updated with the formulas: 


[ 25 ] 


1 ' 


X4 

*3 

-X2 

-xi 

-X3 

Xl4 

XI 

-X2 

X2 

-Xl 

XI* 

-X3 


X2 

X3 

X4 


•^eas 
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0 

0 

0 

1 


X5 


+ K sign(q4)q' 


X6 

X? 
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127] P*-^(1-KG)P* 
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where, again, multiplication by G is done Implicitly, and la 

the measured quaternion representing target attitude. 


Finally, th^ state estimate and covariance are transformed back to the 
primary coordinate system: 


[28] 


St 



[29] 

P 


T 1 

TP*iiT I 

TP* 12 

(TP*12)^ j 

P*22 


where 

and x*j^ are elements of i and 

and P*^j are submatrices of P and P*, which are partitioned as 
above . 

These calculations are done In subroutine INCRPA. 

C. POSITION FILTER CHANGED LITTLE 

Two changes were made to the Kalman filter that estimates translational 
position and velocity: 


1) The calculation for the measurement covariance matrix was revised 
to reflect the better measurements provided by a better camera and 
the Improved Image interpretation algorithm described In Section 
V. The new formulas also acknowledge that measurement errors 

In X, y, and z directions are correlated and unequal. 

2) Tlie covariance propagation formulas were modified to reflect less 
uncertainty in thruster forces. Like the measurement formulas, 
these formulas now acknowledge that uncertainties are not equal In 
each direction and that they are correlated. 

1. Measurement Covariance 


Subroutine ESTCOV estimates the measurement error covariance from two 
empirical equations, derived by fitting curves to experimental data: 

[30] Vj = 8 X 10"'^(r - 5)^* + 0.005 

for errors along the chase vehicle x axis (camera boreslght); and 

[31] V2 = 7.36 X lO-'^Cr^) + 0.016 

for errors along either the y or the z axis. 

In these formulas r Is the estimated range to the target. 

The values computed from Equations [30] and [31] form the diagonal ele- 
ments of the covariance matrix: 

[32] Vi 0 0 

R = 0 V2 0 

0 0 V2 
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which Is expressed in vehicle coordinates. To be useful In the filter, 
the natrlx oust be converted to the prlnary reference fraae: 


1331 R-i- 


T 

A RA 
c c 


where Is the direction cosine natrlx defining the chase vehicle's 
attitude with respect to the prlnary frane. Is supplied by the 
Inertial neasurenent unit. 

2. Covariance Propagation 

Between neasurements the state estimate's accuracy degrades, because: 

1) Initial uncertainty In velocity leads to steadily Increasing uncer** 
talnty In position; 

2) If thrusters are used, the resulting acceleration cannot be known 
exactly; even accelerometer measurements will contain some error; 

3) There will be differential gravitational accelerations between the 
chase vehicle and the target, due to gravity gradient, even when 
the thrusters are not used; 

4) Oversimplifications In the dynamics model and numerical errors 
(roundoff, truncation, and approximations In formulas and values of 
variables) cause a steady growth In estimation errors. 

Subroutine PROPES explicitly models thrust uncertainty and the effect 
of velo' "y errors on future position errors. iRie remaining error 
sources are accounted for by adding a small, positive, constant, dlago** 
nal matrix to the covariance matrix during propagation. 
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NEWTON-RALIHSON ITERATION IMPROVES IMAGE INTERPRETATION 


The original Image-Interpretation algorithm did not consider perspec- 
tive effects, which become significant only at close range* During 
this contract phase, we added a subroutine (MPROVE) that accounts for 
perspective effects. This subroutine Improves the Interpretation ac- 
curacy and decreases correlation between errors In target attitude 
measurements and errors In chase vehicle position measurements. 

The principle behind this routine Is the Newton-Ralphson method for 
solving systems of nonlinear equations. This method starts with an 
Initial guess, which Is the Interpretation provided by the original 
algorithm, and successively refines it. 

The first three elements of the Initial guess, R, are the x, y, and z 
components of the chase vehicle's position, expressed In the primary 
reference frame used for navigation. The remaining three elements are 
the first three elements of a quaternion that expresses the difference 
between the target spacecraft's attitude and some reference attitude. 

In the program, the reference attitude Is taken to be the measured at- 
titude, so this quaternion Is the Identity quaternion, and the first 
three elements are zero. The use of only three elements for the qua- 
ternions relies on the fact that a quaternion can be premultlplled by 
-1.0 If necessary to guarantee that Its fourth element Is positive. 
Therefore, It can be reconstructed from the other three elements with 
no ambiguity, because, by convention, all the quaternions have magni- 
tudes of 1.0, and the sign of the missing element Is now known. 

The routine Is given a measurement vector In which the first three ele- 
ments are the horizontal Image-plane coordinates of the three docking 
aid lamps* The remaining three vector elements are the vertical coor- 
dinates for these lamps. 

If near-linear equations relate small changes In the viewing position 
and target attitude to ch-anges In lamp Image coordinates. 



[ 34 ] 


(v 

— meas 


V ,) 

— pred 


H(x - ±) 


where 


V Is the measurement vector described previously: 

—meas 

X Is the true position/attitude vector (with the quaternion portion 
expressing the error In the quaternion portion of &); 

Is a measurement vector predicted from ft; 

ft Is the Initial guess at x, derived from the original Image-Interpre- 
tation algorithm; 


H Is the matrix defining the near-linear relationship between changes 
In X and changes In v. 


Iterations based on this approximation converge to the true solution If 

the Initial guess Is close enough to the solution so that (x - ft) and 

(v - V .) are small quantities. The matrix H Is a matrix of 
-meas -pred ’ 

partial derivatives: 
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The first three rows of H represent the sensitivity of the horizontal 
components of the three lamps’ Image-plane coordinates to changes In 
the position/attitude vector. Each of these rows can be computed from 
the same formula by changing the value of h^, the lamp's position In 
the target reference frame, to represent each lamp In turn. The ex- 
pression for these rows Is: 


[ 36 ] 


-r2 




1 

'o 

-h 

h 




1 

I 


t3 

t2 


1 0 

A 

c 

^3x3 1 


0 





1 

1 

-h 

h 

0 




1 

t2 











f 


In which 


£ Is the lamp's position In the camera's reference frame, computed from 



h^ Is the lamp's position In the target reference frame; 

and are direction cosine matrices that specify chase-vehicle 
and target attitude with respect to the primary frame used for 
navigation; 

X Is the position/attitude vector described previously; 

Is the camera's position In the chase-vehicle frame; 
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f l8 the lens focal length; 


1 is the 3x3 Identity oatrlx. 

For quantities that are unknown (A^, x), the measured value provided 
by the original Image-Interpretation algorithm Is used. The state es- 
timate from the Kalman filter could be used for this purpose, but use 
of the measurements allows the system to be self-starting. 

Furthermore, It simplifies the repeated use of subroutine MPROVE for 
successively refining the Interpretation. Each time the subroutine Is 
reexecuted. It starts with the Interpretation It produced the previous 
time. Because It reduces the Interpretation error by approximately a 
factor of 10 each time It Is executed. It can make the error Insignifi- 
cant In two executions. (The errors caused by camera noise cannot be 
removed by any Interpretation scheme. They can only be averaged out by 
taking multiple measurements. This Is the function of the Kalman fil- 
ters, not of subroutine MPROVE.) The procedure calculates the last 
three rows of H from a formula almost identical to Equation (36). 

These rows correspond to the sensitivity of the vertical components of 
the lamp-image coordinates to changes In x. Ihey are calculated from: 



Because a major portion of the calculation Is the same for Equations 
[36] and [38], they are merged In the procedure to minimize the arith- 
metic. After calculating H, the procedure solves Equation [34] for 
(x - i), the difference between the refined estimate and the initial 
guess. This error Is added to the Initial guess. However, the quater- 
nion portion of X expresses the error In the measured quaternion; It 
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does not represent attitude with respect to the primary reference 
frame. To get the attitude with respect to this frame, the procedure 
multiplies the error quaternion by the measured quaternion. 
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GOAL-SELECTION STRATEGY CHANGES 


A simple control system has no need for goal-selection logic. It sim- 
ply tries to minimize the error between the commanded position and the 
current position. Its control law may Include some form of anticipa- 
tion of the future (e.g., a phase-lead network) or other compensation 
to stabilize the control loop or Improve performance, but It does not 
have to think very much to perform satisfactorily. 

Such a control system Is not suitable for a video rendezvous guidance 
system that operates with tumbling target spacecraft. The guidance 
system must reduce the position error to zero, but It also must also do 
so without endangering Itself or the target. This means that It must 
reason about avoiding a path that goes through the target. It must 
also avoid getting too close to the target when Its knowledge of Its 
position may be In error, and make allowance for the finite size of 
both the target and the chase vehicle so that the two spacecraft do not 
bump Into each other at the side or rear end. Furthermore, It must try 
to keep the docking aid within the field of view of the television cam- 
era and. If possible, minimize fuel use. 

The goal-selection logic Implemented In the simulation program attempts 
to do all these things. To minimize the complexity of the task, we 
have divided the problem Into two nearly Independent subproblems, atti- 
tude and position control. 

A. ATTITUDE GOAL SELECTION 


Attitude control Is by far the simpler of the two problem. The logic 
for attitude goal selection Is In subroutine RPY, which replaces two 
subroutines (ESTRPY and RPY) of the original program. The original 
routines used the state estimate from the Kalman filter only when di- 
rect video Imagery was unavailable. In contrast, the new routine al- 
ways use the state estimate and never use the video Image data direct- 
ly. This Is possible because the filter now provides target attitude 
Information as well as position data. 
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The strategy of the subroutine Is slaple: it adjusts yaw and pitch 

angles to keep the chase vehicle's docking fixture pointed directly at 
the end of the target's docking fixture » and it adjusts the roll angle 
to align the caaera with the docking aid lights. 

It allows for target notion by predicting the target's attitude aud the 
chase vehicle's position at then end of the sanple interval, 1.2333 a 
into the future. This anticipation reduces errors by coapensatlng for 
control system lag. 

1. The Logic of RPY 

Subroutine RPY first propagates the state estiaates for position and 
target attitude 1.2333 s into the future so that all planning is based 
on where things will be at the end of the decision interval, not on 
where they are at the stsrt of the interval. Because noveaent in this 
time Interval will be saall, the subroutine uses simple Euler numerical 
Integration of the state ectlaates with the assuaption that all thrust- 
ers are off. 

It then computes the vector from the chase vehicle center of aasa (at 
its assumed new position) to the tip of the target's docking fixture 
(at its assumed new poslclon). This vector is expressed in the chase 
vehicle's coordinate system: 

1391 £ - - «) 

where 

A and are direction cosine matrices that describe the attitudes 
c t 

of the chase vehicle and the target; 
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Hdt Is the posltloo of the docking fixture tip in the target's body 
coordinate systen; 




^ is the estimated chase vehicle position. 


The subroutine then estimates yaw and pitch errors from arc tangents of 
the ratios of the elements of £: 


[40] (yaw error) ■ tan 




[41] 


(pitch error) = tan 




The roll error is found by calculating a unit vector r that is parallel 
to the target "-y" axis. This vector is expressed in the chase vehi- 
cle's body coordinate system. Then, 

(roll error) - tan”^ ( 

V ^2 


B. TRANSLATIONAL POSITION GOAL SELECTION 

The logic of subroutine SETGOL selects a translational position goal. 

It starts by predicting the target's attitude, but it predicts farther 
into the future than the end of the decision Interval, because the 
cnase vehicle may take several minutes to reach the target. The number 
of seconds of anticipation is an empirically chosen function of range. 
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We found that bad performance resulted from too much antlcipe'.ion: the 

chase vehicle did not match the docking fixture's tangential velocity 
component well. Too little .:>ntlclpatlon was also bad: the chase vehl> 

cle lagged behind the docking fixture, resulting In poor alignment. 

The empirical formula that seemed to give best overall results allowed 
0.2 e anticipation for each meter of range, with a maxlmua anticipation 
of 20 s. 

Because nonllnearltles could be significant In propagating attitude for 
20 s, we used second-order Runge-Kutta numerical integration rather 
than the much simpler Euler Integration. However, no perceptible per- 
formance Improvement results from this, because significant errors oc- 
cur only at a considerable distance from the target. 

After predicting target attitude, the subroutine selects a goal on the 
chase vehicle's docking axis. The distance between the goal and the 
target la at least enough to accommodate the docking fixtures of the 
two spacecraft. Undr" certain circumstances, however, an additional 
aafety margin la allowed. 

Plfst, at diatar\ces over l.i m from the target, the subroutine allows 
for a rsfety margin of twice the standard deviation associated with Its 
state estimate, or approximately three Claes the probable error In Its 
krowledge of .Its position. The accuracy Information It needs to com- 
pute this margin Is taken from the diagonal elements of the covariance 
matrix maintained by the Kalman filter. 

second, the subroutine allows additional margin for misalignment be- 
tween the two spacecraft. For example. If the chase vehicle Is In the 
right position but the wrong attitude. It might damage the target with 
Its solar panels. The allowance for misalignment varies from zero to 
19. S m, depending on the mount of misalignment. 


I 

! 

i 
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Third, subroutine MODGOL analyzes the path from the current position to 
the goal. If it finds that the goal is on the far side of the target 
and that the path passes too close to the target, it revises the goal. 
The new goal it selects is on the shortest circular path around the 
target at a safe distance. 
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APPENDIX A--PROGRAM LISTING 


The program listing in this appendix is provided to document the simu- 
lation methods used in analyzing the three-light video guidance system 
and running the simulation. It was written to run on a Prime 550 com- 
puter under the PRIMOS operating system, but it has few hardware- 
dependent subroutines. If It is to be run on another computer, the 
following information will prove useful. 

Several library routines are used, and these are not shown in the list- 
ing. The routines Include ASIN and ACOS, which compute the Inverse 
trigonometric functions arc sine and arc cosine. The function RANFN is 
a random number generator that computes normally distributed random 
values with a specified mean and standard deviation. In addition, the 
matrix arithmetic routines MADO (addition), MSJB (subtraction), MMLT 
(multiplication), MINV (matrix inversion), MSCL (multiplication by a 
scalar), MIDN (setting an array equal to the identity matrix), and MTRN 
(forming the transpose of a matrix) are used from the Prime library 
MATHLB. 

File handling may present conversion problems even if the program is to 
be run on another Prime 550 computer, because logical unit numbers, 
file names, and amount of disk storage vary from installation to in- 
stallation. Standard Prime subroutines are used to open and close 
files. These subroi tines (TSRCii, EXST$A,CL0SiA, and DELEiA) are from 
the Prime library APPLIB. 

Run time is approximately twice real time if the computer is dedicated 
to one user. 

The perspective drawings shown in this report are not created directly 
by this program. They are drawn by a second program that uses the data 
file created by this program. This allows the creation of stereo plots 
and views from different perspectives. 



Several WRITE statements in subroutine DOCK are rendered inactive by a 
character C in the first column of text. Removing this character will 
provide a printout at the operator's terminal for monitoring the prog- 
ress of the simulation; 

The first part of the listing Is the text of a terminal session, which 
Includes compilation, loading, and execution of the program. 
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